
METHOD FOR DETERMINING AND TRACKING THE POSITION AND ORIENTATION 

OF A MAGNETIC FIELD SENSOR 

Field of the Invention 

0001 The invention relates to a method for determining and tracking the changing, true position and 
orientation of a magnetic field sensor within a three-dimensional magnetic field space with the 
aid of the values supplied by the magnetic field sensor as measuring position and measuring 
orientation. 

Background of the Invention 

0002 For a realistic simulation of images that change when the head position and head orientation of 
the observer changes, e.g. of panoramic image details shown on the night-vision goggles of a 
pilot, the observer's point of sight and thus his/her exact head position and orientation must be 
known for a precise calculation of the image detail that changes with the head movement. A 
magnetic field is generated in a real space in which the observer is seated, e.g. in the cockpit of 
an airplane or a helicopter, and a magnetic field sensor is attached to the head of the observer for 
sensing the magnetic field. The values measured by the magnetic field sensor represent a 
measure for the momentary head position or the momentary orientation of the observer's head in 
the magnetic field space and are referred to in the following as measuring position and 
measuring orientation. 

0003 A magnetic field sensor of this type operates without problems in the undisturbed, homogeneous 
magnetic field. However, the magnetic field of most magnetic field spaces is distorted by the 
presence of metal objects, for example the metal struts of a flight simulator cockpit. The 
measuring values output by the magnetic field sensor thus deviate from the true position and 
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orientation of the magnetic field sensor in the real magnetic field space. In the distorted 
magnetic field space, the measuring values output by the magnetic field sensor must therefore be 
corrected to obtain the actual or so-called true position and true orientation of the magnetic field 
sensor, which is indispensable for a precise and realistic simulation of the image details. 

0004 A number of different methods are known for correcting the false measuring values output by the 
magnetic field sensor that is located in the distorted magnetic field. However, these methods do 
not yield sufficient and satisfying results, at least not for sight simulation. With one known 
method, the correlation between the true position and true orientation of the magnetic field 
sensor and the values measured by this sensor is determined experimentally and stored in a 
calibration table. In a pre-processing step, the calibration space is scanned and an approximation 
is used to obtain the associated, real position values by using the calibration table and 
interpolating the position values in the real magnetic field space. During the measuring phase, a 
trilinear interpolation is performed between the actually measured positions and the real position 
values to obtain the true position of the magnetic field sensor. (Volodymyr Kindratenko 
"Calibration of electromagnetic tracking device," Virtual Reality, Research, Development, and 
Applications, Vol. 4, 1999, pages 139 - 150, with reference to Raab, Blood, Steioner, Jones: 
"Magnetic position and orientation tracking system; IEEE Transactions on Aerospace and 
Electronic Systems 1979, 15(5), pages 709 - 718). This method is based on the assumption that 
the magnetic field interference in a space is linear, which is true only in exceptional cases. 

0005 Thus, there is a need for a robust method for determining the true values for position and 
orientation of a magnetic field sensor from the measuring values output by the magnetic field 
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sensor. The method should provide results that are usable for sight simulation even in magnetic 
fields with heavy distortion or interference. 
Summary of the Invention 

0006 The advantage of the method according to embodiments of the invention is that the area directly 
surrounding the magnetic field sensor in the real magnetic field space is used for correcting the 
measuring values. Thus, the method still delivers good results, even with considerable 
differences locally in the interference of the magnetic field, that is even under conditions where 
the prior art methods fail. Thus, it is possible with the method according to embodiments of the 
invention to provide a fairly accurate true position and constant tracking of this position. This 
allows the method to avoid the problems of ambiguity that have occurred in previous attempts. 

0007 According to one advantageous embodiment of the invention, a transformation matrix A is 
determined with the aid of four calibration positions taken from a calibration table. The 
calibration positions span a tetrahedron that encloses the measuring field position in the three- 
dimensional calibration space coordinate system, such that the four calibration positions are 
transformed correctly to the three-dimensional coordinate system of the real magnetic field 
space, which in the following is referred to a real space coordinate system. In order to determine 
the true position, the transformation matrix A is then applied to the measuring position. 

0008 If p M is the position vector of the measuring position and p is the position vector of the 
transformed measuring position, which corresponds to the true position of the magnetic field 
sensor, then the following applies: 

p=A-p M +p ofT • (1), 

wherein p off is an offset that should be taken into consideration during the transformation. 
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0009 According to one advantageous embodiment of the invention, a first calibration position of the 
four calibration positions is moved to a point of origin of the calibration space coordinate system 
prior to the transformation, so as to avoid the offset determination, and the other three calibration 
positions are displaced by the position coordinates of the first calibration position. Of the grid- 
point positions associated with the four calibration positions, the first grid-point position 
belonging to the first calibration position is moved to the point of origin of the real space 
coordinate system and the remaining three grid-point positions are displaced by the position 
coordinates of the first grid-point position. The transformation to the real magnetic field space, 
or to be more precise to the three-dimensional coordinate system of the real magnetic field space 
(real space coordinate system), is realized with the aid of the displaced calibration positions as 
follows: 

Pi V = Ap ™ y with i = 1,2,3 (2). 

An equation system including nine transformation equations with nine unknown quantities is 
obtained, from which the transformation matrix A can be easily computed. With each new 
measuring value, the calibration positions that span the tetrahedron are determined anew and the 
transformation matrix is also computed anew. 

00010 If the transformation matrix is applied to the measuring position, the latter must also be first 
displaced accordingly in the calibration space coordinate system. This displacement is reversed 
again following the transformation to the real space coordinate system, thus resulting in a fairly 
accurate true position of the magnetic field sensor in the magnetic field space. 

0001 1 The true magnetic field sensor position is first determined on the basis of a measuring value from 
the magnetic field sensor, as described in the above. According to one advantageous 



-4- 





embodiment of the invention, the true position of the magnetic sensor is then used to determine a 
corrected orientation for the magnetic field sensor. The corrected orientation is then used to 
determine the true orientation of the magnetic field sensor for the measuring orientation. 

00012 According to one advantageous embodiment of the invention, a trilinear interpolation is 
performed to determine the correction orientation with the calibration orientations, for which the 
associated grid-point positions in the real space coordinate system span a cube that encloses the 
true position of the magnetic field sensor. 

Brief Description of the Figures 

00013 The invention is described in further detail in the following, with the aid of an exemplary 
embodiment illustrated in the drawing Shown are in: 

Figure 1 A flow chart illustrating a method according to an embodiment of the invention; 
Figure 2 Sectional views of the structuring of a magnetic field space with the three- 



dimensional coordinate system x, y, z in a three-dimensional grid with equidistant 



grid points; 



Figure 3 



A sectional view of a calibration table, empirically collected in the magnetic field 



space; 



Figure 4 



Sectional views of a two-dimensional representation of the calibration positions in 



the three-dimensional calibration space coordinate system of the calibration table 



to explain the cumulative position; 



Figure 5 



An example of one of eight grid-point positions in the three-dimensional 



coordinate system of the cube spanning the real magnetic field space; 
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Figure 6 One of the eight calibration positions, allocated to the eight grid-point positions 
according to Figure 5, in the three-dimensional space element that spans the 
calibration space coordinate system; 

Figure 7 The space element according to Figure 6, with six tetrahedrons contained therein; 
and 

Figure 8 A schematic diagram for the vector definition used to search for a tetrahedron that 

encloses the measuring position. 
Detailed Description of the Preferred Embodiment 
00014 The method illustrated in the flow chart shown in Figure 1 is used to correctly determine a 
position and orientation of a magnetic field sensor that moves within a three-dimensional 
magnetic field space, even if the magnetic field generated in the magnetic field space is disturbed 
or distorted in some regions and the magnetic field sensor delivers incorrect measuring values for 
the true position and true orientation in those regions. In the following, the measuring values 
output by the magnetic field sensor are referred to as measuring position and measuring 
orientation. The method is preceded by a calibration mode in which the magnetic field space is 
structured into a three-dimensional grid with equidistant grid points. One grid point is preferably 
located at the point of origin of a three-dimensional coordinate system x, y, z that in the 
following is called the real space coordinate system. Each grid point thus has a position vector 
p with the coordinates x, y and z. Figure 2 contains sectional views of a real space coordinate 
system of this type with a grid structure. In this case, the coordinates x 8 , ys and z 8 are provided 
as example coordinates for the grid point 8. The magnetic field sensor is then positioned 
successively and with constant orientation or alignment at all of the grid points. The values 
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measured by the magnetic field sensor at each grid point are allocated as a calibration position 
and a calibration orientation to the real position of the grid point and are stored in a calibration 
table. Figure 3 shows sections of an example of a calibration table. Each grid point has a 
position vector p with the coordinates x, y, z in the real magnetic field space, to which a 
position vector p M with the calibration position x M , and z M is allocated, as well as a rotation 
vector of the calibration orientation p M, ° with the orientation values for heading h M , pitch p M 
and roll r M . The calibration positions are located in a three-dimensional coordinate system of the 
calibration space, which in the following is called the calibration space coordinate system. In 
contrast to the grid positions in the real magnetic field space, the calibration positions in the 
calibration space are not equidistant. The calibration is preferably made only once and is 
superimposed again only if the magnetic field space and/or the magnetic field generated therein 
is changed. 

00015 If necessary, the data stored in the calibration table are processed further, for example to correct 
incorrect algebraic signs during a hemisphere change or to fill in missing data that could not be 
measured at specific grid points by using interpolation or extrapolation. With the method 
described in further detail in the following for determining the true position and the true 
orientation of the magnetic field sensor from the measuring values provided by the sensor, the 
true position of the magnetic field sensor in the magnetic field space is initially determined and 
this position is subsequently used to determine the true orientation of the magnetic field sensor. 
The most important part of the position determination is the determination of four calibration 
points from the calibration table that span a tetrahedron in the calibration space coordinate 
system that encloses the measuring position actually measured by the magnetic field sensor. If 
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such a tetrahedron is found, a linear interpolating transformation of the measuring position to the 
real magnetic field space is carried out with those four calibration positions. The transformed 
measuring position is output as the true magnetic sensor position. For this, a transformation 
matrix A is determined with the aid of the four calibration positions, such that the four 
calibration positions are correctly transformed to the real space coordinate system. With the aid 
of the transformation matrix obtained in this way, the measuring position is transformed as 
follows: 

p=A-p M +p° tt (1) 
to the real space coordinate system. In this case, p M is the actually measured position, p is the 

true position of the magnetic field sensor in the real space coordinate system and p off is an offset 
that must be taken into account during the transformation. To avoid having to compute the offset 
when computing the transformation matrix A, as well as when applying the transformation 
matrix A to the measuring position for transforming the measuring position to the real magnetic 
field space, one of the first four calibration positions is initially displaced to the point of origin of 
the three-dimensional calibration space coordinate system and the other calibration positions are 
displaced by the position coordinates of the first calibration position. Also, of the grid points 
allocated to the four calibration positions, the first grid point position belonging to the first 
calibration position is moved to the point of origin of the three-dimensional real space coordinate 
system and the remaining grid-point positions are displaced by the position coordinates of the 
first grid-point position. With the aid of the calibration positions p \ M,v , displaced in this way, 
and the grid point positions p \ V , the calibration position is thus transformed to the real space 
coordinate system as follows: 
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p? = Ap { M > y with i = 1,2,3 (2) 

As a result, an equation system with nine equations and nine unknown values is obtained, which 
looks as follows when written as a matrix: 



(3) 



From this equation system, the elements Ai,i, Ai, 2 ... of the transformation matrix A can be easily 
computed. This transformation matrix is not applied directly to the measuring position, but to a 
measuring position that has been displaced in the same way as the three calibration positions in 
the calibration coordinate system. In other words, the vector subtracted from the position vector 
of the measuring position is the vector of the calibration position which has been displaced to the 
point of origin of the three-dimensional calibration coordinate system. The transformation 
matrix is applied to the displaced measuring position p M,v as follows: 

p V = Ap M ' v (4) 
To obtain the true position p of the magnetic field sensor from this measuring position p v that 
has been transformed to the real magnetic field space and is still displaced, the displacement 
must be reversed again by adding the position vector of the grid-point position that has been 
displaced to the point of origin of the real space coordinate system to the position vector of the 
transformed, displaced measuring position p v . 
00016 Once the true position of the magnetic field sensor is determined, as described in the above, the 
true orientation of the magnetic field sensor is determined. For this, a correction orientation is 
determined with the aid of the true magnetic field sensor position and is applied to the measuring 
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orientation measured by the magnetic sensor for determining the true orientation. To determine 
the correction orientation, eight calibration positions for which the associated grid-point 
positions in the real space coordinate system span a cube that encloses the true position of the 
magnetic field sensor are selected from the calibration table. A trilinear interpolation is then 
performed with these eight calibration orientations, which results in the correction orientation. 
This correction orientation is either applied individually to the orientation values h M , p M and r M 
or, preferably, to the rotation vector p M, ° formed with these values. 

0001 7 In order to determine whether or not a tetrahedron spanned by four calibration positions in the 
calibration space coordinate system of the calibration table encloses the measuring position, it is 
determined for all four surfaces of the tetrahedron on which side of the tetrahedron surface the 
measuring position is located. If the measuring position for all four tetrahedron surfaces is 
located on the same side of the tetrahedron surface as the associated fourth tetrahedron point that 
does not belong to the tetrahedron surface, then the tetrahedron is identified as one that encloses 
the measuring position. 

0001 8 Using tetrahedron surfaces when searching for the enclosed measuring position avoids 
discontinuity for the interpolated magnetic field sensor position. Figure 8 shows a tetrahedron of 
this type, which is spanned by the calibration positions. For the sake of simplicity, the corner 
points of the tetrahedron, which respectively correspond to a position vector for a calibration 
position in the calibration space coordinate system, are given the references Pi, P2, P3 and P 4 . 
The position vector for the measuring position in the calibration space coordinate system is given 

the reference Pm. The vector representation in Figure 8 shows that two vectors and/or 
P X P 3 are defined between the first corner point Pi of the tetrahedron surface Pi, P2, P3 and the 
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two corner points P 2 and/or P 3 of the tetrahedron surface. The cross product P X P 2 xP } P 3 is 
computed. To determine on which side of the tetrahedron surfaces spanned by the corner points 
Pi, P2, P3 and/or Pi, P 2 , P4 and/or Pi, P3, P4 and/or P 2 , P3, P4, the measuring position is located. 
This cross product results in a product vector, positioned perpendicular on the two vectors, 
meaning the normal for the tetrahedron surface to be viewed Pi, P 2 , P 3 . Between the first corner 
point of the tetrahedron surface Pi and the fourth tetrahedron point P 4 that is not included in the 
tetrahedron surface on the one hand and the corner point Pi and the measuring position Pm on the 

other hand, an additional vector P X P 4 and P X P M is defined and the scalar products of the cross 

product vector are computed with each of the additional vectors P } P 4 and/or P X P M . If the scalar 
products have the same algebraic signs, the measuring position P M is identified as being on the 
correct side of the tetrahedron surface that is viewed. The cross product and the scalar products 
are computed for each of the four tetrahedron surfaces. If the measuring position for all 
tetrahedron surfaces is identified as being on the correct side, the tetrahedron formed by the four 
tetrahedron surfaces is the one searched for, which encloses the measuring position. 

00019 The search for the four suitable calibration positions that enclose the measuring position and thus 
should be used for the linear interpolating transformation of the measuring position, is carried 
out as follows and as illustrated in the flow chart in Figure 1. 

00020 Calibration and initialization are performed, per blocks 10, 12. With the arrival of the first 
measuring position from the magnetic field sensor, block 14, a search on a global level is started 
in the calibration table, henceforth called a global search, block 16. 
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00021 In the calibration process, block 10, the distance to the measuring position is determined for all 
stored calibration positions in the table and the calibration position with the shortest distance, 
henceforth called global calibration position, is then output. To shorten the computing time for 
this process, calibration positions are pre-selected for the shortest distance to the measuring 
position during an initialization step, block 12, that occurs prior to the global search, block 16. 
For this, the table is divided into several table sections and a cumulative position is defined in 
each table section. The determination of the cumulative positions requires approximately the 
same number of calibration positions. Figure 4 shows a two-dimensional sectional view of the 
calibration positions stored in the table in the form of black points to illustrate the initialization 
action. Two table regions are defined in this segment, which are separated by the dividing line 
G. A cumulative position (marked by crosses) is determined for each region. A global search is 
then conducted in such a way that once the first measuring value from the magnetic field sensor 
arrives, only the distance from the measuring position to the cumulative positions is determined 
and not the distance from the measuring position to the calibration positions. The cumulative 
position with the shortest distance to the measuring position is then output as the global 
calibration position. 

00022 With the next measuring value, a so-called environmental search is conducted starting with the 
global calibration position, blocks 18, 20. During the environmental search, a plurality of 
calibration positions are defined, for which in the real magnetic field space the associated grid- 
point positions span a plurality of adjoining cubes arranged around a central grid-point position. 
Figure 2, for example, shows eight adjoining cubes grouped around a central grid-point position 
(grid point 8). The central grid-point position (grid point 8) is determined to be the grid-point 
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position associated with the global calibration position that is determined with the global search. 
A comparison of Figures 5 and 6 shows that eight calibration positions are allocated in the 
calibration table to the eight grid-point positions of each cube. Together, these form an 
octagonal, non-symmetrical space element in the calibration space coordinate system. Figure 7 
shows that this space element can be divided into six tetrahedrons. For the exemplary 
embodiment with eight defined cubes, eight space elements with respectively six tetrahedrons 
are obtained. Following this, a tetrahedron test is performed for each tetrahedron during the 
environmental search, as previously described, block 22. If no tetrahedron meeting the test 
criteria is found during the environmental search, the process returns to block 14 and the global 
search is re-started with the next measuring value and a new environmental search is then carried 
out. If a tetrahedron that encloses a measuring position is found during the environmental 
search, the testing for further tetrahedrons is stopped and the linear interpolating transformation 
is realized as described in the above with the calibration positions that define the found 
tetrahedron, blocks 24, 26. Once the true position of the magnetic field sensor is determined in 
this way, the true orientation is determined and the following measuring value from the magnetic 
field sensor awaited. 

00023 If a new measuring value arrives, a local search is started in the calibration table to find the four 
calibration positions suitable for spanning the tetrahedron which encloses the measuring position 
in the calibration space coordinate system, blocks 28, 30. Eight calibration positions are used for 
this, the associated grid positions of which describe a cube in the real space coordinate system, as 
shown in Figure 5. The eight calibration positions belonging to this cube define an octagonal 
space element in the calibration space coordinate system, as shown in Figure 6. This space 
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element in turn contains six tetrahedrons, such as the ones numbered 1 to 6 in Figure 7. During 
the local search, a tetrahedron test is carried out for each of the six tetrahedrons, as described in 
the above. A cube and/or an associated space element is selected during the local search, in 
which a tetrahedron enclosing the measuring position was found during the preceding measuring 
cycle. In general, the cube selection is determined through prediction based on preceding 
measuring cycles, wherein the true position found in the preceding measuring cycle offers itself 
as the simplest prediction. If a tetrahedron enclosing the measuring position is found during the 
local search, block 32, the linear interpolating transformation of the measuring position is carried 
out with the four calibration positions that determine the tetrahedron, which results in the true 
position of the magnetic field sensor that is used to determine the true orientation of the 
measuring field sensor. Following this, the next measuring value delivered by the magnetic field 
sensor is awaited. Since a tetrahedron enclosing the new, current measuring value is generally 
found, the method largely winds down within the method phase shown with dash-dot line in 
Figure 1. 

00024 If no suitable tetrahedron is found during the local search and after checking all six tetrahedrons, 
an environmental search is conducted, block 34, as described in the above. A predicted grid- 
point position is selected as central grid-point position and is spanned by the adjoining cubes, 
wherein the prediction occurs based on preceding measuring cycles. In the simplest case, the 
grid-point position that is closest to the true position determined during the preceding measuring 
cycle is predicted as central grid-point position. If a suitable tetrahedron is found in the process, 
block 36, the orientation determination and position determination are stared once more and the 
following measuring value is awaited, blocks 24-28. If no suitable tetrahedron is found during 
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the environmental search, the values determined during the preceding measuring cycle for the 
true position and true orientation of the magnetic sensors are "frozen," block 38, meaning they 
are retained and not changed based on the current measuring value. The following measuring 
value is then awaited, block 40. Since the freezing interrupts the position tracking, a global 
search as described in the above is carried out with the following, new measuring value from the 
magnetic field sensor and the global calibration position is determined in the process, blocks 42, 
44. An environmental search is conducted with the measuring value and the pre-determined 
global calibration position, in the same way as previously described, block 46. If the correct 
tetrahedron is found during the environmental search, then its calibration position is used to 
determine the true position and following this the true orientation of the magnetic field sensor, 
block 48. If no suitable tetrahedron is found during this environmental search either, the values 
determined during the preceding measuring cycle for the true position and true orientation of the 
magnetic field sensor are "frozen" and the following measuring value awaited, blocks 50, 52. A 
new environmental search is conducted with the following new measuring value and, if a 
suitable tetrahedron is found, a new position and orientation determination is triggered, blocks 
54, 56. If no suitable tetrahedron is found, the true values for position and orientation, 
determined during the preceding measuring cycle, are frozen again, block 38, whereupon the 
process returns to block 40 and a global search is started with the next new measuring value. 
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